%% 该文件用于绘制图像
clear all;
clc;
%% 数据导入
data = importdata('data.csv');
E = zeros(1, 4000);
%% 整个过程
% 姿态角
figure;
plot(data(:,10), data(:,1),'linewidth',1.5);
hold on;
plot(data(:,10), data(:,2),'linewidth',1.5);
plot(data(:,10), data(:,3),'linewidth',1.5);
plot(data(:,10), E, '--k','linewidth',1.5);
grid on;
xlabel('time(s)');
ylabel('theta(deg)');
% 姿态角速度
figure;
plot(data(:,10), data(:,4),'linewidth',1.5);
hold on;
plot(data(:,10), data(:,5),'linewidth',1.5);
plot(data(:,10), data(:,6),'linewidth',1.5);
plot(data(:,10), E, '--k','linewidth',1.5);
grid on;
xlabel('time(s)');
ylabel('w(deg/s)');
% % 喷气力矩
% figure;
% plot(data(:,10), data(:,7),'linewidth',1.5);
% hold on;
% plot(data(:,10), data(:,8),'linewidth',1.5);
% plot(data(:,10), data(:,9),'linewidth',1.5);
% plot(data(:,10), E, '--k','linewidth',1.5);
% grid on;
% xlabel('time(s)');
% ylabel('Tq(N*m)');
% % 动量轮转速
% figure;
% plot(data(:,10), data(:,11),'linewidth',1.5);
% hold on;
% plot(data(:,10), data(:,12),'linewidth',1.5);
% plot(data(:,10), data(:,13),'linewidth',1.5);
% plot(data(:,10), E, '--k','linewidth',1.5);
% grid on;
% xlabel('time(s)');
% ylabel('wheelspeed(r/min)');
%% 速率阻尼部分
% 姿态角速度
figure;
plot(data(1:1000,10), data(1:1000,4),'linewidth',1.5);
hold on;
plot(data(1:1000,10), data(1:1000,5),'linewidth',1.5);
plot(data(1:1000,10), data(1:1000,6),'linewidth',1.5);
plot(data(1:1000,10), E(1:1000), '--k','linewidth',1.5);
grid on;
xlabel('time(s)');
ylabel('w(deg/s)');
% 喷气力矩
figure;
subplot(3,1,1);
plot(data(1:1000,10), data(1:1000,7),'linewidth',1.5);
hold on;
grid on;
xlabel('time(s)');
ylabel('TqX(N*m)');
subplot(3,1,2);
plot(data(1:1000,10), data(1:1000,8),'linewidth',1.5);
hold on;
grid on;
xlabel('time(s)');
ylabel('TqY(N*m)');
subplot(3,1,3);
plot(data(1:1000,10), data(1:1000,9),'linewidth',1.5);
hold on;
grid on;
xlabel('time(s)');
ylabel('TqZ(N*m)');
%% 姿态机动部分
% 姿态角
figure;
plot(data(1201:2600,10), data(1201:2600,1),'linewidth',1.5);
hold on;
plot(data(1201:2600,10), data(1201:2600,2),'linewidth',1.5);
plot(data(1201:2600,10), data(1201:2600,3),'linewidth',1.5);
plot(data(1201:2600,10), E(1201:2600), '--k','linewidth',1.5);
grid on;
xlabel('time(s)');
ylabel('theta(deg)');
% 姿态角速度
figure;
plot(data(1201:2600,10), data(1201:2600,4),'linewidth',1.5);
hold on;
plot(data(1201:2600,10), data(1201:2600,5),'linewidth',1.5);
plot(data(1201:2600,10), data(1201:2600,6),'linewidth',1.5);
plot(data(1201:2600,10), E(1201:2600), '--k','linewidth',1.5);
grid on;
xlabel('time(s)');
ylabel('w(deg/s)');
% 动量轮转速
figure;
plot(data(1201:2600,10), data(1201:2600,11),'linewidth',1.5);
hold on;
plot(data(1201:2600,10), data(1201:2600,12),'linewidth',1.5);
plot(data(1201:2600,10), data(1201:2600,13),'linewidth',1.5);
plot(data(1201:2600,10), E(1201:2600), '--k','linewidth',1.5);
grid on;
xlabel('time(s)');
ylabel('wheelspeed(r/min)');
% 喷气力矩
figure;
subplot(3,1,1);
plot(data(1201:2600,10), data(1201:2600,7),'linewidth',1.5);
hold on;
grid on;
xlabel('time(s)');
ylabel('TqX(N*m)');
subplot(3,1,2);
plot(data(1201:2600,10), data(1201:2600,8),'linewidth',1.5);
hold on;
grid on;
xlabel('time(s)');
ylabel('TqY(N*m)');
subplot(3,1,3);
plot(data(1201:2600,10), data(1201:2600,9),'linewidth',1.5);
hold on;
grid on;
xlabel('time(s)');
ylabel('TqZ(N*m)');
